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ABSTRACT 


Kalman  filters  for  target  tracking  typically  use  a  process  noise  defined  in  the  tracking 
frame.  This  requires  setting  the  variances  of  the  process  noise  in  all  three  Cartesian  coor¬ 
dinates  to  values  large  enough  to  compensate  for  the  largest  possible  target  maneuver.  In 
general,  the  maneuvers  performed  by  aircraft  flying  at  high  speeds  are  constant  speed  turns 
in  a  plane  which  are  known  as  coordinated  turns.  An  aircraft  performs  a  coordinated  turn  by 
controlling  its  lateral  acceleration  which  is  approximately  orthogonal  to  its  velocity  vector. 
Thus,  it  is  logical  that  most  of  the  uncertainty  involved  in  tracking  these  targets  is  in  the 
direction  of  the  lateral  acceleration.  This  information  can  be  exploited  by  supplementing  a 
standard  Kalman  filter  with  a  target-oriented  process  noise.  A  target-oriented  process  noise 
is  obtained  by  rotating  a  process  noise,  defined  in  the  target’s  frame,  into  the  tracking  frame. 
The  rotation  matrix  is  computed  from  the  state  estimates  of  the  Kalman  filter. 

The  results  of  Monte  Carlo  simulations  are  presented  which  demonstrate  that  a  Kalman 
filter  with  a  target-oriented  process  noise  tracks  coordinated  turning  targets  with  smaller 
root-mean-square  errors  than  a  Kalman  filter  with  standard  process  noise.  It  was  determined 
that  if  the  target-oriented  process  noise  is  to  be  effective,  the  Kalman  filter  must  generate 
an  acceleration  estimate  and  the  target’s  maneuver  should  be  confined  to  a  plane. 
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CHAPTER  1 
INTRODUCTION 


One  of  the  more  difficult  targets  to  track  is  an  aircraft  flying  at  high  speeds  and  perform¬ 
ing  maneuvers.1-4  In  general,  the  maneuvers  performed  by  aircraft  flying  at  high  speeds  are 
constant  speed  turns  in  a  plane  which  are  known  as  coordinated  turns.  An  aircraft  performs 
a  coordinated  turn  by  controlling  its  lateral  acceleration  which  is  approximately  orthogonal 
to  its  velocity  vector.4-7  Thus,  it  is  logical  that  most  of  the  uncertainty  involved  in  tracking 
these  targets  is  in  the  direction  of  the  lateral  acceleration.  This  information  can  be  exploited 
by  supplementing  a  standard  Kalman  filter  with  a  target-oriented  process  noise. 

Most  target  tracking  algorithms  use  a  Kalman  filter  in  which  the  uncertainty  of  the 
target’s  maneuvers  is  modeled  with  a  process  noise.1,2  Since  the  process  noise  is  usually 
defined  in  the  tracking  frame,  the  variances  for  each  coordinate  must  be  set  high  enough 
to  account  for  the  largest  possible  maneuver  in  each  coordinate  regardless  of  the  target’s 
orientation.  This  method  imposes  artificially  high  variances  for  the  process  noise  because 
the  uncertainty  due  to  maneuvers  must  be  equally  distributed  among  the  three  coordinates. 

A  Kalman  filter  with  a  target-oriented  process  noise  is  obtained  by  defining  the  process 
noise  in  the  target’s  frame  and  then  rotating  it  into  the  tracking  frame.  By  defining  the 
process  noise  in  the  target’s  frame,  the  designer  can  set  a  high  value  for  the  variance  of  the 
lateral  acceleration  to  account  for  the  largest  possible  maneuver  and  lower  values  for  the 
variances  of  the  accelerations  orthogonal  to  the  lateral  acceleration.  Thus,  using  a  target- 
oriented  process  noise  provides  the  same  tracking  error  through  coordinated  turns  with  a 
lower  total  acceleration  error  variance. 
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A  Kalman  filter  with  a  target-oriented  process  noise  designed  to  track  coordinated  turn¬ 
ing  targets  is  presented.  The  filter  uses  a  rotation  matrix  to  rotate  a  process  noise  defined  in 
the  target’s  frame  into  the  tracking  frame.  The  Kalman  filter  is  implemented  with  three  dif¬ 
ferent  motion  models.  The  three  motion  models  are  constant  velocity,  constant  acceleration, 
and  mean-jerk  which  is  a  constant  acceleration  model  with  time-correlated  jerks. 

This  report  is  organized  as  follows.  In  Chapter  2,  the  problem  of  target  tracking  is 
discussed.  The  techniques  for  modeling  the  motion  of  the  targets  are  presented  in  Chapter 
3.  Chapter  4  explains  the  method  used  to  implement  a  Kalman  filter  with  a  target-oriented 
process  noise.  Chapter  5  compares  the  performance  of  tracking  filters  using  a  target-oriented 
process  noise  are  to  that  of  tracking  filters  with  a  standard  process  noise.  A  summary  and 
conclusions  are  given  in  Chapter  6,  and  the  references  are  given  in  Chapter  7.  Derivations 
of  the  rotation  matrices  are  given  in  Appendix  A,  and  an  algorithm  which  can  be  used  to 
generate  error  ellipses  from  filtered  variances  is  presented  in  Appendix  B. 


1-2 


NAVSWC  TR  91-701 


CHAPTER  2 

PROBLEM  FORMULATION 


The  problem  considered  in  this  report  is  the  tracking  of  a  single  target  maneuvering 
through  coordinated  turns  with  no  clutter  or  false  measurements.  In  this  chapter,  the  equa¬ 
tions  used  to  model  the  target  dynamics  and  measurements  are  discussed.  This  chapter 
concludes  with  a  presentation  of  the  Kalman  filter  which  is  used  for  target  tracking  in  this 
report. 


MODEL  OF  TARGET  DYNAMICS 

The  equation  used  to  model  the  dynamics  of  a  maneuvering  target  is  given  by 

X  =  f(X,u,w)  (2.1) 

where  X  is  the  state  vector,  u  is  the  target  control  vector,  and  w  is  the  process  noise  vector 
representing  possible  deviations  in  /(•).  The  motion  of  the  target  is  a  continuous- time  process 
as  indicated  by  Equation  (2.1),  where  /(•)  is  a  dynamic  constraint  that  defines  the  motion 
for  the  target  in  the  form  of  a  differential  equation.  The  dynamic  constraint,  which  is  usually 
unknown  to  the  tracking  system,  can  differ  significantly  between  targets  and  change  for  a 
common  target  during  the  tracking  process. 

The  major  problem  with  tracking  maneuvering  targets  is  that  the  control  vector  is  not 
directly  observable  by  the  tracking  system.  When  the  target  applies  a  control,  a  bias  or  lag 
develops  in  the  estimates  of  the  target  state.  The  control  can  be  included  as  acceleration 
ill  the  dynamic  constraint  /(•),  but  the  acceleration  of  coordinated  turning  targets  usually 
varies  with  time  in  such  a  manner  that  a  filter  model  cannot  be  clearly  identified  during 
tracking. 
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The  target  dynamics  are  usually  modeled  as  linear  in  a  Cartesian  coordinate  frame 
to  simplify  the  filtering  and  reduce  the  computations  required.  Also,  for  convenience  the 
continuous- time  dynamics  equation,  Equation  2.1,  is  discretized.  Thus,  the  equation  used 
to  model  the  target  dynamics  is  given  by 

Xi+x  =  AkXk  +  Bkwk  (2.2) 

where  wk  ~  A(0,  Qk)  is  the  process  noise  and  Ak  and  Bk  model  the  dynamics  of  the  target. 
The  Qk  is  the  covariance  matrix  of  the  process  noise  which  is  constant  and  diagonal  for 
the  Kalman  filter  with  standard  process  noise  but  is  dependent  upon  the  orientation  of  the 
target  for  the  Kalman  filter  with  target-oriented  process  noise.  The  target  state  vector,  Xk, 
may  contain  the  position,  velocity,  and  acceleration  of  the  target  at  time  k,  a s  well  as  other 
variables  used  to  model  the  time-varying  acceleration.  For  a  Kalman  filter  with  standard 
process  noise,  the  process  noise  covariance  matrix  is  given  by 

'flfc  0  °1 

Qk  =  0  q\  0  (2.3) 

[0  0  q\ 

where  qxk ,  q9k,  and  qzk  are  the  variances  of  the  process  noise  in  Cartesian  coordinates.  The 
qki  qk,  and  qzk  are  given  the  same  value  since  the  direction  of  the  target  control  vector,  u  in 
Equation  (2.1),  is  usually  not  observable. 

MEASUREMENT  MODEL 

The  equation  used  to  model  the  measurements  of  the  target’s  true  state  is 

Zk  =  h{Xk,vk)  (2.4) 

where  Zk  is  the  discrete-time  measurement  vector  at  time  k ,  and  vk  is  the  measurement  noise 
vector.  As  indicated  by  Equation  (2.4),  the  measurement  process  is  discrete-time  because 
most  sensors  used  for  target  tracking  record  the  position  and/or  radial  velocity  at  a  given 
instant  in  time.  In  this  report,  the  measurement  process  will  be  modeled  as  linear.  Most 
sensors  used  for  target  tracking  measure  the  target  position  in  a  spherical  coordinate  system, 
but  the  spherical  measurements  can  be  transformed  into  a  Cartesian  coordinate  frame  for 
processing  as  a  linear  function  of  the  target  state.  The  transformati  m  from  spherical  to 
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Cartesian  coordinates  is  given  by 

x  =  R  cos E  sinB  (2.5a) 

y  =  R  cos E  cos B  (2.5 b) 

z  =  R  sin E  (2.5c) 

where  R,  B,  andE  are  the  range,  bearing,  and  elevation,  respectively.  Thus,  the  linear  mea¬ 
surement  process  is  then  given  by 

Zk  =  HkXk  +  vi t  (2.6) 

where  Zk  is  the  target  measurement  in  the  Cartesian  coordinate  frame.  The  mean  of  the 
measurement  noise,  vi,  is  =  0,  and  the  covariance  matrix  of  the  measurement  noise 

is  Rk  =  £[ufcvj].  The  Hi  is  a  vector  which  selects  the  states  which  correspond  to  the 
measurements  and  (iu  a  single  coordinate)  is  given  by 

J?*  =  [  1  0  0  Oj  (2.7) 

for  a  4  state  model  with  measurements  of  position  only.  The  Hi  for  a  3  state  model  is  the 
first  3  elements  of  Equation  (2.7)  and  the  first  2  elements  for  a  2  state  model. 


The  measurement  errors  in  spherical  coordinates  are  usually  assumed  to  be  white  and 
Gaussian  and  uncorrelated  in  range,  bearing,  and  elevation,  but  the  transformation  to  the 
rectangular  coordinate  frame  causes  the  components  of  vi  to  become  non-Gaussian  and  cor¬ 
related.  Nevertheless,  for  most  probability  calculations  Vi  is  often  assumed  to  be  Gaussian. 
The  correlation  between  the  components  of  vi  can  be  modeled  by  linearizing  the  transfor¬ 
mation  from  spherical  to  Cartesian  coordinates  of  Equation  (2.5)  with  a  first-order  Taylor 
series.  Thus,  the  covariance  matrix  of  the  measurement  noise,  Ri,  is  computed  from  the 
equation 


'<4  o  O' 

II 

n?® 

o  o 

_ i 

UT 

(2.8) 

f  cos E  sin B  R  cos E  cos B 

—R  sin E  sin B 

u  = 

cos  E  cosB  — 

R  cos E  sinB 

— R  sinB  cosB 

(2.9) 

sinB 

0 

RcosE 

where 


and  and  4  are  the  measurement  error  variances  for  range,  bearing,  and  elevation, 

respectively.  The  B,  B,  andE  are  the  estimated  range,  bearing,  and  elevation,  respectively, 
which  are  computed  from  the  state  estimates  at  time  k. 
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CHAPTER  3 

i  TARGET  MOTION  MODELING 


The  three  different  motion  models  considered  in  this  report  are  constant  velocity,  con¬ 
stant  acceleration,  and  mean-jerk.  The  constant  velocity  and  constant  acceleration  motion 
models  are  commonly  used,  but  the  mean-jerk  motion  model  is  relatively  new.  These  three 
motion  models  are  described  in  this  chapter.  For  simplicity,  the  motion  models  are  presented 
in  the  form  that  would  be  used  to  track  in  a  single  coordinate.  The  motion  models  used  to 
track  in  three  coordinates  simultaneously  are  block  diagonal  matrices,  with  the  A*  and  R* 
matrices  presented  in  this  chapter  forming  the  blocks. 


CONSTANT  VELOCITY 


The  first  model  presented  is  constant  velocity  and,  for  a  single  coordinate,  the  motion 
model  is  given  by 


I 

I 


Ak  = 


1 

0 


T' 

1 


Bt  =  [  0.5T2 


(3.1) 

(3.2) 


where  T  is  the  time  interval  between  measurement  k  and  k  +  1.  The  elements  of  the  state 
vector  Xk  are  position  and  velocity.  In  this  report,  a  Kalman  filter  using  this  motion  model 
is  referred  to  as  a  CV  filter. 
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CONSTANT  ACCELERATION 

The  second  model  is  constant  acceleration  and,  for  a  single  coordinate,  the  motion  model 
is  given  by 


1  T  0.5  T2 
0  3  T 
L0  0  1 


A* 

Si=[o.5rJ  T  l] 


(3.3) 

(34) 


The  elements  of  the  state  vector  for  this  model  are  position,  velocity,  and  acceleration.  A 
Kalman  filter  using  this  motion  model  is  referred  to  as  a  CA  filter  in  this  report. 


MEAN-JERK 

The  third  model  is  the  mean-jerk  model  which  is  the  standard  constant  acceleration 
model  with  time- correlated  jerk.  The  use  of  the  time- correlated  jerk  represents  the  fact  that 
the  acceleration  changes  in  a  deterministic  manner  as  a  target  maneuvers.  Thus,  the  jerk  at 
time  k  will  be  related  to  those  at  time  A;  —  1  if  the  difference  between  these  times  is  small. 
The  continuous-time  form  of  the  mean-jerk  model,  in  a  single  coordinate,  is  given  by 


'0 

1 

0 

0  1 

'0" 

x  = 

0 

0 

0 

0 

1 

0 

0 

1 

x  + 

0 

0 

0 

0 

0 

—  T 

1 

w(t) 


(3.5) 


where 


X  =  [  x  x  x 


(3.6) 


The  variable,  x],  is  the  jerk  which  is  the  time  derivative  of  the  acceleration.  The  discrete-time 
form  of  the  model  is  given  by 


A*  = 


Bk  = 


1  T  O.hT2  t-3(0.5(tT)2  ~tT  +  1  -  e~rT) 
0  1  T  ~~2  1--tT 

0  0  1 

'  ,-tT 


T-l(e-ri  —  1  +rT)) 
t-1(1  —  e~rT ) 


0  0 


0 


T ~\l(rT)z  -  0.5(rT)2  +  (tT  -  1  +  c~tT)) 
t_3(0.5(t!T)2  -tT+  1  -  e~rT) 


-2  („-rT 
r-1(l  —  e-r7 ) 


T~1{e~rl  -  1  +  tT )) 


(3.7) 


(3.8) 
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and 

lr 

Xk  =  [xfc  it  xk  a;£j  (3.9) 

The  variable  r  is  related  to  the  correlation  of  the  jerk.  In  this  report,  r  was  chosen  to  be  0.5 
to  give  a  2  second  time  constant  for  the  correlation.  In  the  derivation  of  the  discrete-time 
model,  w(t)  in  Equation  (3.5)  was  assumed  to  be  constant  between  times  k  and  k  +  1.  A 
Kalman  filter  using  the  motion  model  given  by  Equations  (3.7)  and  (3.8)  is  referred  to  as  a 
MJ  filter  in  this  report. 
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CHAPTER  4 

TARGET-ORIENTED  PROCESS  NOISE 

The  method  used  to  implement  a  Kalman  filter  with  a  target-oriented  process  noise 
is  described  in  this  chapter.  First,  the  reasons  for  using  a  target-oriented  process  noise  are 
discussed.  Then,  a  process  noise  covariance  matrix  defined  in  the  target’s  frame  is  presented. 
Next,  the  rotation  matrices  used  to  rotate  the  process  noise  defined  in  the  target’s  frame 
into  the  tracking  frame  are  presented.  Finally,  the  Kalman  filter  with  target-oriented  process 
noise  is  presented. 

REASONS  FOR  USING  A  TARGET-ORIENTED  PROCESS  NOISE 

The  Kalman  filter  with  target-oriented  process  noise  allows  the  designer  to  define  the 
process  noise  covariance  in  terms  of  thrust  and  lateral  accelerations.  This  allows  the  Kalman 
filter  to  more  realistically  model  the  maneuverability  of  the  target.  Most  targets  maneuver 
by  controlling  their  thrust  acceleration  which  is  parallel  to  the  target  velocity  vector,  and/or 
their  lateral  acceleration  which  is  orthogonal  to  the  target  velocity  vector.  Except  for  mis¬ 
siles  in  launch  or  boost  phases,  the  thrust  acceleration  of  most  targets  is  limited  to  10  m/s2. 
However,  the  lateral  acceleration  can  approach  150  m/s2.  Thus,  when  tracking  a  maneuver¬ 
ing  target,  a  wider  range  of  uncertainty  exists  due  to  the  lateral  acceleration  than  due  to 
the  thrust  acceleration.  For  this  reason,  a  Kalman  filter  with  target-oriented  process  noise 
can  model  the  acceleration  uncertainty  more  accurately  than  a  Kalman  filter  with  standard 
process  noise.  This  causes  the  error  covariances  of  the  state  estimates,  Equation  (2.14)  to 
have  a  smaller  trace.  Smaller  error  variances  lead  to  smaller  errors  and  smaller  position  error 
ellipsoids.  Reducing  the  errors  in  the  state  estimates  improves  the  performance  of  fire  control 
systems,  and  reducing  the  volume  of  the  position  error  ellipsoids  improves  the  tracking  of 
targets  in  a  cluttered  environment. 
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PROCESS  NOISE  COVARIANCE  IN  TARGET’S  FRAME 

The  process  noise  covariance  matrix  defined  in  the  target’s  frame  is 

Vt  o  o  ' 

<?'/  =  o  0  (4.1) 

L0  0  ,“J 

where  gj.  is  the  variance  of  the  thrust  acceleration,  qk  is  the  variance  of  the  lateral  acceler¬ 
ation,  and  q k  is  the  variance  of  the  acceleration  orthogonal  to  both  q\  and  qlk.  The  target’s 
frame  is  defined  with  the  X  axis  aligned  with  the  target’s  velocity  vector,  the  Y  axis  aligned 
with  the  target’s  lateral  acceleration  vector,  and  the  Z  axis  aligned  with  the  cross  product  of 
the  target’s  velocity  and  lateral  acceleration  vectors  which  forms  a  right-handed  coordinate 
system.  The  value  of  qlk  is  determined  in  the  exact  same  manner  that  qk,  qk,  and  qk  are  de¬ 
termined  in  a  Kalman  filter  with  standard  process  noise.  The  value  of  qk  is  set  to  A qk,  where 
0  <  A  <  1.  This  is  done  because  the  targets  considered  in  this  report  are  constant  speed,  so 
there  is  less  uncertainty  in  the  thrust  acceleration  as  compared  to  the  lateral  acceleration. 
The  value  of  qk  is  set  to  one  of  two  values.  For  the  CV  filter,  qk  is  set  to  qlk,  and  for  the 
CA  and  MJ  filters,  qk  is  set  to  7 qk  where  0  <  7  <  0.01.  The  variance,  qk,  is  lowered  for 
the  CA  and  MJ  filters  because  the  targets  considered  in  this  report  maneuver  by  performing 
coordinated  turns.  Since  a  coordinated  turn  is  defined  as  a  constant  speed  turn  in  a  plane, 
there  will  be  little  acceleration  uncertainty  in  the  direction  of  qk  which  is  orthogonal  to  this 
plane.  This  cannot  be  done  in  the  CV  filter  because  no  acceleration  estimate  is  calculated, 
so  the  plane  defined  by  the  velocity  and  lateral  acceleration  vectors  cannot  be  determined. 
Thus,  for  the  CV  filter,  there  is  equal  acceleration  uncertainty  in  the  directions  of  qk  and  qk. 


ROTATION  MATRIX 


A  target-oriented  process  noise  requires  a  rotation  matrix  to  rotate  the  process  noise, 
defined  in  the  target’s  frame,  into  the  tracking  frame.  Two  different  rotation  matrices  are 
presented.  A  rotation  matrix  based  on  velocity  and  acceleration  estimates  is  used  for  the 
CA  and  MJ  filters,  and  a  rotation  matrix  based  on  velocity  estimates  only  is  used  for  the 
CV  filter.  The  rotation  matrix  used  in  the  CA  and  MJ  filters  is 


V*_  VtxA\ 

in!  Ki  1H1141 


(4.2) 
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7*  . 

where  V*  =  [i*  yk  zk]  is  the  velocity  vector  of  the  target,  Ak  = 


-l 


4 


*]! 


IS 


ength  of  V t,  and 


the  lateral  acceleration  vector  of  the  target,  |V*|  is  the  magnitude  or 
Vk  x  Ak  is  the  cross  product  of  Vk  and  Alk.  The  lateral  acceleration  vector,  Ak,  is  computed 
by  subtracting  the  thrust  acceleration  vector  from  the  acceleration  vector,  At,  using  the 


equation7 


At  =  At  — 


(Ak-Vk) 

IHI2 


V* 


(4.3) 


The  rotation  matrix  used  for  the  CV  filter  is 
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Sh 
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(4.4) 


where  S  =  |Vt|  and  Sh  =  (xk -f  i .  The  rotation  matrix  for  the  CV  filter  given  by  Equation 
(4.4)  is  derived  in  Appendix  A  from  the  rotation  matrix  for  the  CA  and  MJ  filters  given  by 
Equation  (4.2).  Since  the  true  state  of  the  target  cannot  be  determined  during  tracking,  the 
filtered  estimates  of  the  target’s  state  are  used  in  Equations  (4.2),  (4.3),  and  (4.4). 


KALMAN  FILTER  WITH  TARGET-ORIENTED  PROCESS  NOISE 

A  Kalman  filter  with  target-oriented  process  noise  is  obtained  by  rotating  the  process 
noise  defined  in  the  target’s  frame  into  the  tracking  frame.  The  target  state  model  of 
Equation  (2.2)  then  becomes 

Xt+ 1  =  AkXk  +  BkDkw‘‘  (4.5) 

where  is  the  process  noise  defined  in  the  target’s  frame,  and  Dk  is  a  rotation  matrix 
given  by  either  Equation  (4.2)  for  the  CA  and  MJ  filters  or  Equation  (4.4)  for  the  CV  filter. 
The  only  Kalman  filter  equations  explicitly  affected  by  the  process  noise  are  the  time  update 
equations,  Equations  (2.10)  and  (2.11).  Since  the  process  noise  is  considered  to  be  zero  mean 
in  this  report,  Equation  (2.10)  is  not  affected  by  the  rotation  of  the  process  noise.  Equation 
(2.11)  becomes 


Pk+\\k  —  AkPklkAj  -f  BkQrkB J 


(4.6) 
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where  Qrk  is  the  rotated  process  noise  covariance  given  by 

Q’k  =  DtQ‘‘Dl  (4.7) 

where  Dt  is  the  rotation  matrix  and  Q]?  is  the  process  noise  covariance  matrix  defined  in 
the  target’s  frame  given  by  Equation  (4.1).  Thus,  to  obtain  a  Kalman  filter  with  target- 
oriented  process  noise,  the  standard  Kalman  filter  given  by  Equations  (2.10-14)  are  used 
except  Equation  (2.11)  is  replaced  by  Equation  (4.6). 
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CHAPTER  5 
RESULTS 


Simulation  results  of  Kalman  filters  with  target-oriented  process  noise  are  compared  with 
those  of  Kalman  filters  with  standard  process  noise  Simulation  results  for  Kalman  filters 
with  three  different  motion  models  are  presented  for  four  different  target  trajectories.  The 
standard  process  noise  filters  and  target-oriented  process  noise  filters  are  compared  on  the 
basis  of  root-mean-square  (RMS)  errors,  filtered  error  covariances,  process  noise  covariances, 
and  position  error  ellipses.  All  of  the  figures  referred  to  in  this  chapter  are  located  at  the 
end  of  the  chapter. 


TARGET  TRAJECTORIES 

The  four  target  trajectories  used  in  the  filter  simulations  are  all  constant  speed  with 
some  type  of  coordinated  turn.  The  speed  used  for  all  four  trajectories  was  300  m/s.  One 
trajectory  was  used  to  generate  the  simulation  results  for  the  CV  filters,  and  the  other  three 
trajectories  were  used  to  generate  the  simulation  results  for  the  CA  and  MJ  filters.  The 
trajectory  used  for  the  CV  filters  is  a  weave  in  the  X-Y  plane  with  a  peak  acceleration  of 
2.5  m/s2  and  a  constant  altitude  of  1  km.  This  trajectory  is  referred  to  as  Trajectory  1 
in  this  report;  Figure  5-1  illustrates  this  trajectory.  The  trajectories  used  for  the  CA  and 
MJ  filters  are  referred  to  as  Trajectories  2,  3,  and  4  in  this  report.  Trajectory  2  is  a  weave 
in  the  X-Y  plane  with  a  peak  acceleration  of  30  m/s2  and  a  constant  altitude  of  1  km. 
Trajectory  3  is  a  constant  speed  turn  in  a  plane  rotated  45  degrees  about  the  X  axis  with  a 
peak  acceleration  of  30  m/s2  .  Trajectory  4  is  a  constant  speed  turn  in  the  X-Y  plane  with 
a  peak  acceleration  of  30  m/s2  and  a  constant  altitude  of  1  km.  Figures  5-2,  5-3,  and  5-4 
illustrate  these  trajectories. 


5-1 


NAVSWC  TR  91-701 


These  trajectories  were  used  to  simulate  radar  measurements  by  adding  white  Gaussian 
noise  to  the  true  spherical  coordinate  trajectory  (i.e.  Range,  Bearing,  and  Elevation).  These 
simulated  radar  measurements  were  converted  to  Cartesian  coordinates  using  Equations 
(2.5a, b,c).  A  new  set  of  radar  measurements  was  generated  for  each  run  of  the  Monte  Carlo 
simulations. 


PARAMETER  SELECTION 

The  parameters  that  were  the  same  for  all  of  the  simulation  results  were  the  data  rate,  the 
standard  deviations  of  the  measurement  noise,  the  number  of  data  points  used  to  initialize 
the  track,  and  the  number  of  runs  used  for  Monte  Carlo  simulations.  The  data  rate  was 
chosen  to  be  5  Hz.  The  standard  deviations  of  the  measurement  noise  were  chosen  to  be  8  m 
in  the  range  coordinate  and  2  mrad  in  the  bearing  and  elevation  coordinates.  The  number 
of  data  points  used  to  initialize  the  track  was  chosen  to  be  5.  The  number  of  runs  used  in 
the  Monte  Carlo  simulations  to  compute  the  RMS  errors  was  chosen  to  be  200. 

The  standard  deviation  of  the  measurement  noise  was  estimated  for  each  trajectory,  so 
the  process  noise  variances  could  be  chosen.  The  measurement  noise  standard  deviation  was 
assumed  to  be 

CTr  4"  Rmax^b  4"  /. 

<7m  =  - g -  (5.1) 

where  the  subscripts  m,  r,  b,  and  e  denote  measurement,  range,  bearing,  and  elevation 
respectively,  and  Rmaz  is  the  maximum  range  for  the  particular  trajectory.  The  values 
calculated  for  am  for  each  trajectory  are  presented  in  Table  5-1. 

TABLE  5-1.  STANDARD  DEVIATION  OF  MEASUREMENT  ERRORS 


Trajectory 

1 

2 

3 

4 

Std  Dev  (m) 

40.4 

40.4 

18.7 

56.0 
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The  process  noise  covariances  matrices  were  the  only  other  parameters  required  to  per¬ 
form  the  simulations.  To  simplify  the  discussions  of  the  results,  the  Kalman  filters  with 
standard  process  noise  are  referred  to  as  SPN  filters,  and  the  Kalman  filters  with  target- 
oriented  process  noise  are  referred  to  as  TOPN  filters. 

The  SPN  filters  use  the  process  noise  covariance  matrix  given  in  Equation  (2.3).  The 
diagonal  elements  were  chosen  to  be  equal  (i.e.  q£  =  qj!  =  qj  =  q*).  The  process  noise 
variance,  qt,  was  calculated  from  the  steady-state  position  gain,  the  variance  of  the  mea¬ 
surement  errors,  and  the  time  interval  between  measurements.12  The  steady-state  position 
gain,  a  (the  same  variable  used  in  an  a  -  fi  filter),  was  chosen  to  be  0.3.  The  TOPN  filters 
use  the  process  noise  covariance  matrix  given  in  Equation  (4.1).  The  variances  of  the  process 
noise  for  the  TOPN  filters  were  determined  from  the  value  of  qt  for  the  corresponding  SPN 
filter.  For  the  CA  and  MJ  TOPN  filters,  q\.  =  q[.  =  q*  and  =  O.Olqjt.  For  the  CV  TOPN 
filter,  qj.  =  qjf  =  q*  and  qj.  =  q*/4.  The  values  for  these  process  noise  variances  for  both  the 
SPN  and  TOPN  filters  are  presented  in  Tables  5-2,  5-3,  and  5-4. 

TABLE  5-2.  VARIANCES  OF  PROCESS  NOISE  FOR  CV  FILTER 


qk  (m2/s4) 

q*  (m2/s4) 

q*1  (m2/s4) 

qwu  (m2/s4) 

Traj  #1 

4250 

4250/4 

4250 

4250 

TABLE  5  -3.  VARIANCES  OF  PROCESS  NOISE  FOR  CA  FILTER 


qk  (m2/s4) 

q*'  (m2/s4) 

qk‘  (m2/s4) 

qk“  (m2/s4) 

Traj  #2 

35 

35 

35 

0.35 

Traj  #3 

8 

8 

8 

0.08 

Traj  #4 

65 

65 

65 

0.65 
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TABLE  5-4.  VARIANCES  OF  PROCESS  NOISE  FOR  MJ  FILTER 


(m2/s8) 

q*‘  (m2/s8) 

q*1  (m2/s8) 

(m2/s8) 

Traj  #2 

270 

270 

270 

2.7 

Traj  #3 

58 

58 

58 

0.58 

Traj  #4 

518 

518 

518 

5.18 

SIMULATION  RESULTS 

The  root-mean-  square  errors  (RMSE),  filtered  error  covariances,  process  noise  covari¬ 
ances,  and  position  error  ellipses  of  Monte  Carlo  simulations  for  the  SPN  and  TOPN  filters 
are  presented.  The  CV  filters  were  simulated  using  trajectory  1  only.  The  CA  and  MJ  filters 
were  each  simulated  using  trajectories  2,  3,  and  4. 

Root-Mean-Square  Errors 

The  RMSE  obtained  from  these  simulations  are  shown  in  Figures  5-5  through  5-11.  The 
RMSE  were  calculated  by  summing  the  squared  filter  errors  from  all  runs,  dividing  by  200, 
and  then  taking  the  square  root.  The  RMSE  for  the  CV  SPN  and  TOPN  filters  are  shown  in 
Figure  5-5.  The  position  error  was  the  same  for  both  filters  throughout  the  entire  trajectory. 
The  velocity  error  was  slightly  smaller  for  the  TOPN  filter.  The  RMSE  for  the  CA  SPN  and 
TOPN  filters  are  shown  in  Figures  5-6  through  5-8.  The  position,  velocity,  and  acceleration 
errors  were  smaller  for  the  TOPN  filter  for  all  three  trajectories.  However,  of  the  three 
trajectories,  the  largest  reduction  in  errors  occurred  for  trajectory  4  as  shown  in  Figures  5-8. 
Note  that  this  is  also  the  trajectory  in  which  the  range  to  the  target  is  largest.  The  RMSE 
for  the  MJ  SPN  and  TOPN  filters  are  shown  in  Figures  5-7  through  5-11.  The  differences 
between  the  errors  for  these  filters  were  similar  to  those  of  the  CA  SPN  and  TOPN  filters. 
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Filtered  Ercar  Covariance? 

The  filtered  error  covariances  of  the  state  estimates,  given  by  Equation  (2.14),  from  a 
single  run  of  each  filter  are  shown  in  Figures  5-12  though  5-18.  These  error  covariances 
are  the  sum  of  the  error  covariances  of  all  three  coordinates.  As  Figure  5-12  shows,  the 
filtered  error  covariances  for  the  CV  TOPN  filter  are  slightly  less  than  those  for  the  CV  SPN 
filter.  As  Figures  5-13  through  5-18  show,  the  filtered  error  covariances  for  the  CA  and  MJ 
TOPN  filters  are  significantly  less  than  those  for  the  CA  and  MJ  SPN  filters.  Note  that  the 
filtered  error  covariances  c^-nge  slowly  throughout  the  trajectories.  This  happens  because 
the  filtered  error  covariances  are  functions  of  the  Kalman  gain,  Rfc,  which  is  a  function  of 
the  measurement  error  covariance,  J?t,  and  il*  depends  on  the  estimated  range  to  the  target 
(see  Equations  (2.8),  (2.9),  (2.12),  and  (2.14)). 

Process  Noise  Covariances 

The  rotated  process  noise  covariance  matrices  for  the  TOPN  filters  from  a  single  run  of 
each  filter  are  shown  in  Figures  5-19  through  5-25.  In  these  figures,  Qr  denotes  the  rotated 
process  noise  covariance  matrix  given  by  Q[  in  Equation  (4.7),  All  six  elements  of  Qr  are 
plotted  in  each  figure.  The  Qr(l,l),  Qr{ 2,2),  and  <5r(3>3)  are  the  diagonal  elements  of  Qr 
which  are  the  rotated  process  noise  variances  in  the  X,  Y,  and  Z  coordinates,  respectively. 
The  Qr(  1,2)  is  the  rotated  process  noise  covariance  between  the  X  and  Y  coordinates. 
Likewise,  <^r(l,3)  is  the  rotated  process  noise  covariance  between  the  X  and  Z  coordinates, 
and  Qr(2,3)  is  the  rotated  process  noise  covariance  between  the  Y  and  Z  coordinates.  The 
process  noise  covariance  matrices  for  the  SPN  filters,  Equation  (2.3),  are  not  shown  since 
these  matrices  are  always  constant  and  diagonal. 

The  rotated  process  noise  covariance  for  the  CV  TOPN  filter  is  shown  in  Figure  5-19. 
This  filter  uses  the  rotation  matrix  D *,  given  in  Equation  (4.4),  which  is  a  function  of 
velocity  estimates.  The  Qr(3,3)  remains  at  a  larger  value  throughout  the  trajectory  than 
either  Qr(l,l)  or  Qr(2,2).  The  reason  for  this  is  that  the  rotation  of  Q ^  in  Equation  (4.1) 
distributes  part  of  the  Qr(l,l)  and  Qr(2,2)  to  the  covariance  between  X  and  Y,  Qr(l,2). 
Thus,  Qr(l,l)  and  <^r(2,2)  are  reduced,  and  Qr(\,2)  is  increased.  Since  the  target’s  velocity 
vector  remains  in  the  XY  plane  throughout  the  trajectory,  the  rotation  matrix  does  not 
affect  Qr( 3,3),  Qr(l,3),  or  Qr(2,3). 
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The  rotated  process  noise  covariances  of  the  CA  TOPN  filter  are  shown  in  Figures  5- 
20  through  5-22.  This  filter  uses  the  rotation  matrix  Dk,  given  in  Equation  (4.2),  which 
is  a  function  of  velocity  estimates  and  acceleration  estimates.  In  Figure  5-20,  the  target 
maneuvers  in  the  XY  plane,  so  the  lateral  acceleration  vector  remains  in  the  XY  plane. 
Thus,  Qr(l,l)  and  Qr( 2,2)  remain  at  their  maximum  value.  The  4>r(3,3)  remains  at  a  small 
value  since  this  is  the  direction  orthogonal  to  the  plane  of  motion,  and  the  variance  in  this 
direction,  q^,  was  set  to  a  small  value  (see  Table  5-3  and  Equation  (4.1)).  In  Figure  5-21, 
the  target  maneuvers  in  a  plane  slanted  45  degrees  with  respect  to  the  XY  plane.  The 
Qr(l,l)  remains  at  its  maximum  value.  The  Qr( 2,2)  and  Qr(3,3)  were  reduced  by  half,  and 
the  covariance  between  them,  (Jr(2,3),  was  increased.  In  Figure  5-22,  the  target  performs  a 
maneuver  similar  to  the  one  in  Figure  20,  but  at  a  longer  range.  Thus,  all  the  process  noise 
variances  behave  in  a  manner  similar  to  Figure  20.  The  strange  behavior  of  Qr(l,3)  and 
Qr(2,3)  in  Figures  5-20  and  5-22  is  not  understood  at  this  time,  but  the  magnitude  of  these 
anomalies  is  so  small  that  no  explanation  is  warranted. 

The  rotated  process  noise  covariances  of  the  MJ  TOPN  filter  are  shown  in  Figures  5-23 
through  5-25.  These  covariances  behave  in  a  similar  manner  to  the  CA  TOPN  filter.  This  is 
to  be  expected  since  both  filters  used  the  same  trajectories  and  the  same  rotation  matrices. 

Position  Error  Ellipses 

The  position  error  ellipses  calculated  for  a  single  time  step  from  a  single  run  of  the  TOPN 
and  SPN  filters  are  shown  in  Figures  5-26  through  5-32.  These  position  error  ellipses  are 
typical  of  ones  which  would  be  used  to  validate  measurements  in  a  cluttered  environment. 
These  error  ellipses  were  calculated  from  the  filtered  error  covariances  at  the  100^  time 
step  during  a  single  run  of  each  filter,  as  discussed  in  Appendix  B.  The  100th  time  step 
was  arbitrarily  chosen  to  compare  the  relative  sizes  between  position  error  ellipses  calculated 
from  SPN  and  TOPN  filter  covariances.  Both  the  horizontal  and  vertical  position  ellipses  are 
shown,  so  that  the  volume  of  the  position  error  ellipsoids  can  be  estimated.  As  demonstrated 
in  Figure  5-26,  the  CV  TOPN  filter  has  a  slightly  smaller  ellipse  than  the  CV  SPN  filter  in 
the  XY  plane.  As  shown  in  Figures  5-27  through  5-29,  the  CA  TOPN  filter  reduces  the  size 
of  some  of  the  ellipses.  In  Figures  5-27  and  5-29,  only  the  XZ  plane  ellipse  is  smaller  since 
the  target’s  maneuver  is  confined  to  the  XY  plane.  In  Figure  5-2S,  both  the  XY  and  XZ 
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plane  ellipses  are  smaller  since  the  target’s  maneuver  is  confined  to  a  plane  at  a  45  degree 
angle  to  the  Y  and  Z  axes.  The  MJ  TOPN  filter’s  position  error  ellipses  shown  in  Figures 
5-30  through  5-32  were  similar  to  those  of  the  CA  TOPN  filter. 
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FIGURE  5-5.  RMS  ERRORS  FOR  CV  FILTER  -  TRAJ  1 
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FIGURE  5-6.  RMS  ERRORS  FOR  CA  FILTER  -  TRAJ  2 
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FIGURE  5-9.  RMS  ERRORS  FOR  MJ  FILTER  -  TRAJ  2 
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FIGURE  5-10.  RMS  ERRORS  FOR  MJ  FILTER  -  TRAJ  3  £ 
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FIGURE  5-12.  FILTERED  ERROR  COVARIANCES  FOR  CV  FILTER  -  TRAJ  1 
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FIGURE  5-M.  FILTERED  ERROR  COVARIANCES  FOR  CA  FILTER  -  TRAJ  3 
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FIGURE  5-19.  ROTATED  PROCESS  NOISE  COVARIANCES  FOR  CV  FILTER  -  TRAJ  1 
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FIGURE  5-20.  ROTATED  PROCESS  NOISE  COVARIANCES  FOR  CA  FILTER  -  TRAJ  2 


5-23 


NAVSWC  TR  91-701 


t 

< 

CSI 

< 

2 

W 

o 


TIME  (S) 


FIGURE  5-21.  ROTATED  PROCESS  NOISE  COVARIANCES  FOR  CA  FILTER  -  TRAJ  3 
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FIGURE  5-26.  POSITION  ERROR  ELLIPSES  FOR  CV  FILTER  -  TR^J  1 
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FIGURE  5-27.  POSITION  ERROR.  ELLIPSES  FOR  CA  FILTER  -  TRAJ  2 
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FIGURE  5-28.  POSITION  ERROR  ELLIPSES  FOR  CA  FILTER  -  TRAJ  3 


5-36 


Z(M) 


NAVSWC  TE  91-701 


FIGURE  5-29.  POSITION  ERROR  ELLIPSES  FOR  CA  FILTER  -  TRAJ  4 
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FIGURE  5-31.  POSITION  ERROR  ELLIPSES  FOR  MJ  FILTER  -  TRAJ  3 
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CHAPTER  6 

CONCLUSIONS  AND  FUTURE  RESEARCH 


Supplementing  the  standard  Kalman  filter  with  a  target-oriented  process  noise  can  sig¬ 
nificantly  improve  tracking  filter  performance  when  the  target’s  maneuvers  are  confined  to 
a  plane  and  the  filter  generates  an  acceleration  estimate  so  that  the  plane  of  the  maneuver 
can  be  identified.  The  target-oriented  process  noise  can  slightly  improve  the  tracking  perfor¬ 
mance  of  a  constant  velocity  filter.  Adding  a  target- oriented  process  noise  to  a  Kalman  filter 
adds  a  moderate  amount  of  computations.  Therefore,  its  use  is  limited  to  fire  control  appli¬ 
cations  where  only  a  small  number  of  targets  are  tracked,  and  large  errors  in  the  estimates 
are  unacceptable, 

Future  research  may  examine  the  more  realistic  situations  of  targets  performing  elab¬ 
orate  maneuvers  in  the  presence  of  clutter  and  false  measurements  by  incorporating  the 
target-oriented  process  noise  into  algorithms  such  as  the  Interacting  Multiple  Model  Proba¬ 
bilistic  Data  Association  Filter  (IMMPDAF).10  Using  a  target-oriented  process  noise  could 
significantly  improve  tracking  in  a  cluttered  environment  by  reducing  the  volume  of  the  vali¬ 
dation  gates.  Another  subject  for  future  research  is  supplementing  a  Kalman  filter  with  both 
a  target-oriented  process  noise  and  a  kinematic  constraint.6  The  kinematic  constraint  seems 
to  be  compatible  with  a  target-oriented  process  noise  since  it  does  not  affect  the  acceleration 
estimates  in  the  direction  orthogonal  to  the  plane  of  motion. 
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APPENDIX  A 

DERIVATION  OF  ROTATION  MATRIX 

This  appendix  presents  a  derivation  of  the  rotation  matrix  required  to  rotate  a  vec¬ 
tor/matrix  defined  in  the  target’s  frame  into  the  tracking  frame.  This  derivation  is  based  on 
the  development  of  Z-Y-X  Euler  angles.11 

A  Z-Y-X  Euler  angles  rotation  matrix  performs  rotations  about  the  Z,  Y,  and  X  axes 
in  that  order.  The  second  and  third  rotations  are  performed  about  an  axis  rotated  by  the 
previous  rotation;  Figure  A-l  illustrates  these  rotations. 


FIGURE  A-l.  Z-Y-X  EULER  ANGLES 
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Let  gRxyx(cx,P, 7)  be  a  rotation  matrix  describing  frame  {B}  relative  to  {A}  by  Z-Y-X 
Euler  angles.  This  rotation  matrix  can  be  derived  by  viewing  the  rotations  about  {B}  axes 

A 

as  equivalent  to  negative  rotations  about  {A}  axes.  For  example,  rotating  about  Zq  by  an 
angle  a  is  equivalent  to  rotating  about  Z\  by  an  angle  —a.  This  leads  to 

7)  =  ROTfX^-i)  ROT(bY,-/3)  ROT(bZ,-*)  (A.  1) 

Since  JiT1  =  %R  and  ROT-\K,-6 )  =  ROT(K,0 ),  (A.l)  becomes 


bRxVz(<x,P,7)  =  aR~x(<*,P,i) 


(A.2) 


=  ROT(BZ,a)  ROT(BY,/3)  ROT{bX,  7) 


ca 

—sa 

O' 

'  c/3 

0 

s/3' 

'1 

0 

0  ' 

= 

sa 

ca 

0 

0 

1 

0 

0 

n 

-S7 

.  0 

0 

.-s/3 

0 

c/3j 

0 

s' y 

C7  . 

'  ca  c/3  co  s/3  sy  —  so  07  co  s/3  07  4-  sar  57 
so  c/3  so  s/3  S7  +  ca  C7  sa  s/3  ay  —  ca  57 
—s/3  c/3  57  c/3  07 


(-4.3) 

(A.4) 

(-4.5) 


In  Equations  (A.4)  and  (A. 5)  above,  ‘c’  and  ‘s’  are  abbreviations  for  ‘cos’  and  ‘sin.’ 


The  Z-Y-X  Euler  angles  can  be  extracted  from  a  given  rotation  matrix  using  the 
equations 


a  —  atan2(r2i,rn) 

(-4.6) 

/3  =  atan2(— r3i,  yj r|2  +  rjjj) 

(-4.7) 

7  =  atan2(r32,r33) 

(-4-8) 

where  the  r,;'  are  unit  vector  elements  of  some  matrix  defining  the  orientation  of  frame  B  with 
respect  to  frame  A.  Note:  atan2  is  the  two-argument  arc  tangent  function  (also  called  the 
4-quadrant  arc  tangent  function).  Notice  that  the  equations  are  valid  only  when  /3  ^  ±90 
degrees.  When  this  situation  occurs,  a  is  set  to  zero  and  7  is  then  computed  from  the 
equations 

7=  atan2(ri2,r22)  (A.9) 


if  f3  =  90  and 


7=  -atan2(ri2,r22) 


(A.10) 


if  (3  =  -90. 


The  rotation  matrix  given  in  Equation  (4.4)  for  a  constant  velocity  filter  was  derived 
from  the  one  given  in  Equation  (4.2),  as  follows.  The  rotation  matrix  given  in  Equation 
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(4.2)  can  be  computed  from  Z-Y-X  Euler  angles  by  using  Equations  (A.6),  (A. 7),  and  (A.8) 
which  gives 


(A.11) 

. —z  Sh , 

=  atan2(— ,— ) 

(A.  12) 

.  n(  zl  xyl-xly\ 

=“an2Ur  sun  ) 

(A.13) 

where  S  =  | Vfc(  =  (i*  +  yl  +  Sh  —  (ij[  +  y*)^,  and  |A[j  is  the  magnitude  of  the 
lateral  acceleration  vector.  Notice  that  an  acceleration  estimate  is  required  to  compute  7  in 
Equation  (A. 13),  and  a  constant  velocity  filter  does  not  generate  an  acceleration  estimate. 
Thus,  7  in  the  general  rotation  matrix  form  given  in  Equation  (A. 5)  is  set  to  zero  which 
gives 


(3)  — 


col  c/3  —sa  ca  s/3 
sa  c/3  ca  sa  s/3 
—si 3  0  c/3  J 


(A,U) 


where  B  denotes  the  target’s  frame  and  A  denotes  the  sensor’s  frame.  Then  Equation  (4.4) 
is  obtained  by  replacing  ca,  sa,  c/3,  and  s/3  in  Equation  (A. 14)  with  their  equivalents  found 
from  Equations  (A. 11)  and  (A. 12). 
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APPENDIX  B 

ERROR  ELLIPSE  PLOTTING  ALGORITHM 


This  appendix  presents  the  algorithm  used  to  plot  the  position  error  ellipses.  To 
obtain  an  equation  for  a  position  error  ellipse  in  the  horizontal  plane  from  the  filtered  error 
covariance  matrix,  the  following  equation  is  expanded 


* 

(X  Y] 

4 

crx°Y 

_2 

X' 

v 

1 

.<TX<*Y 

aY 

1 

=  Cl 


(B.  1) 


where  X  and  Y  are  the  position  states  in  Cartesian  coordinates,  a\  and  are  the  filtered 
error  variances  of  the  corresponding  position  states  which  are  extracted  from  the  filtered 
error  covariance  matrix,  and  ci  is  a  constant  whose  value  is  found  from  a  Chi-squared  table. 
The  value  chosen  for  ci  determines  the  confidence  region.  For  the  plots  shown  in  Figures  5-26 
through  5-32,  ci  was  chosen  to  be  2.5  which  produced  ellipses  defining  the  99%  confidence 
region.  Equation  (B.l)  can  be  expanded  to  the  form 


X2 


2 pXY  |  Y2 
°XaY  <7y 


=  (1  -  p2)c\ 


(B.l) 


where  p  =  — 

<*X  <*Y 

(B.2)  gives 


is  the  correlation  coefficient.  Using  the  quadratic  formula  to  solve  Equation 


Y  *= 


•b  ±  \/f>2  —  4ac2 

2a 


(B.  3) 


,  1  ,  -2  pX  ,  X2  „  2. 

where  a  =  — s-,  b  — - ,  and  ci  —  — s —  ci(l  —  p  ). 

<7y  O'A C°Y  <*x 

The  horizontal  position  ellipse  is  obtained  by  plotting  Y  of  Equation  (B.3)  for  values  of  X 
in  the  region  defined  by 


<  X 


<+\/' 


ci<Uy 


(BA) 


To  obtain  the  position  error  ellipse  in  the  vertical  plane,  replace  Y  in  Equation  (B.3)  by  Z 
and  replace  a\  by  <r|. 
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